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oped.  To  demonstrate  the  accuracy  and  effectiveness  of  the  method  to  be 
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While  all  the  sample  problems  solved  are  closed-loop  mechanical  systems, 
the  method  described  here  need  not  be  confined  to  closed  loop  mechanical. 
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systems  or  to  mechanical  systems  at  all.  In  fact,  the  method  is  applicable 
to  any  system  whose  motion  is  to  be  described,  provided  adequate  constraints 
can  be  incorporated  into  the  code  by  the  user.  Examples  of  such  systems  are 
electro-mechanical  systems  with  relays,  switches,  etc. 

Given  the  topology  of  a  system,  the  necessary  inputs,  the  method  is 
capable  of  computing  velocities,  positions,  accelerations  and  constraint  forces 
on  the  system. 

Briefly,  the  most  notable  features  of  this  method  are: 

(i)  Complete  generality  in  the  derivation  of  the  constraint  equations  and 
computation  of  the  generalized  co-ordinates. 

(ii)  Use  of  sparse  matrix  subroutines  to  realize  substantial  savings  in 
core  when  problems  of  large  magnitude  are  analyzed. 

(iii)  Versatility  to  incorporate  nonstandard  constraints  into  a  problem, 
if  supplied  by  the  user. 

(iv)  Ability  to  handle  constraints,  when  they  are  supplied  as  a  set  of  dis¬ 
crete  points,  by  constructing  a  third-order  spline  function  through  them 

(v)  Ability  to  perform  kineto-static  analysis  of  a  mechanical  system  if 
the  system  is  kinematically  indeterminate. 
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INTRODUCTION 


It  is  intended  in  this  report  to  develop  a  method  of  kinematically 
analyzing  mechanical  systems.  A  computer  code  that  automatically  gene¬ 
rates  a  set  of  nonlinear  equations  describing  the  system  and  solves  them, 
is  developed.  To  demonstrate  the  accuracy  and  effectiveness  of  the  method 
to  be  developed  herein,  five  sample  problems  have  been  solved. 

While  all  the  sample  problems  solved  are  closed-loop  mechanical 
systems,  the  method  described  here  need  not  be  confined  to  closed  loop 
mechanical  systems  or  to  mechanical  systems  at  all.  In  fact,  the  method 
is  applicable  to  any  system  whose  motion  is  to  be  described,  provided  ade¬ 
quate  constraints  can  be  incorporated  into  the  code  by  the  user.  Examples 
of  such  systems  are  electro-mechanical  systems  with  relays,  switches,  etc. 

Given  the  topology  of  a  system,  and  the  necessary  inputs,  the  method 
is  capable  of  computing  velocities,  positions,  accelerations  and  constraint 
forces  on  the  system. 

Briefly,  the  most  notable  features  of  this  method  are: 

(i)  Complete  generality  in  the  derivation  of  the  constraint  equations  and 
computation  of  the  generalized  co-ordinates. 

(ii)  Use  of  sparse  matrix  subroutines  to  realize  substantial  savings  in  core 
when  problems  of  large  magnitude  are  analyzed. 

(iii)  Versatility  to  incorporate  nonstandard  constraints  into  a  problem,  if 
supplied  by  the  user. 

(iv)  Ability  to  handle  constraints,  when  they  are  supplied  as  a  set  of  dis¬ 
crete  points,  by  constructing  a  third-order  spline  function  through  them. 

(v)  Ability  to  perform  kineto-static  analysis  of  a  mechanical  system  if  the 
system  is  kinematically  indeterminate. 
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CHAPTER  1 


1.1  Introduction: 

The  objective  of  this  report  is  to  formulate  and  implement  a  computer 
code  that  is  capable  of  performing  kinematic  analysis  of  constrained  mechanical 
systems.  The  need  for  such  a  code  arose  because  most  of  the  available  codes 
at  present,  for  example  IMP,  ADAMS,  and  DADS,  are  optimized 
for  transient  dynamic  analysis,  rather  than  for  kinematic  analysis.  Using 
the  above  codes  to  perform  kinematic  analysis  is  tantamount  to  underutiliza¬ 
tion  of  the  code.  Not  surprisingly,  therefore,  the  analysis  process  becomes 
unnecessarily  expensive  and  time  consuming. 

In  this  report,  the  DADS-2D*  code  [1]  is  modified  to  do  kinematic 
analysis.  The  discussion  here  is  limited  to  two  dimensional  problems,  but 
the  method  is  applicable  to  more  general  three  dimensional  systems,  with  few 
modifications. 

1.2  Statement  of  the  problem: 

Given  kinematic  or  force  inputs  to  a  mechanical  system  of  known  topology, 
one  wishes  to  solve  the  equations  of  equilibrium  to  obtain  an  equilibrium 
position  of  the  system  that  is  consistent  with  its  constraints. 

It  is  assumed  that  necessary  matrix  methods  and  other  numerical  algorithms 
are  available  so  they  will  not  be  discussed  in  detail  here. 

1.3  Literature  Review: 

Several  general-purpose  computer  programs  for  dynamic  and  kinematic 
analysis  of  mechanisms  have  been  described  in  the  literature.  These  programs, 
which  automatically  formulate  and  integrate  the  equations  of  motion  are  based 
on  different  but  related  analytical  and  numerical  principles. 

The  major  general-purpose  programs  available  at  the  time  of  writing  are 
given  in  the  following  list  (also  see  lists  in  Refs.  3,  4,  and  8): 

*2D  implies  a  code  that  is  capable  of  analyzing  planar  systems  only. 
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Also,  refer  to  [4]  for  further  details. 

IMP  (Integrated  Mechanisms  Program),  described  by  Sheth  and  Uicker 

[5]; 

DYMAC  (Dynamics  of  Machinery),  developed  by  Burton  Paul,  G.  Hud 
and  A.  Amin  at  the  University  of  Pennsylvania  [6]; 

DRAM  (Dynamic  Response  of  Articulated  Machinery),  described  by  Chace 
and  Smith  [7]; 

MEDUSA  (Machine  Dynamics  Universal  System  Analyzer)  described  by 
Dix  and  Lehman  [8]; 

ADAMS  (Automated  Dynamic  Analysis  of  Mechanical  Systems),  developed 
at  the  University  of  Michigan  by  Orlandea  et  al.  is  described  in  Orlandea 
and  Chace  [9]; 

DADS-2D  (Dynamic  Analysis  of  Dynamic  Systems),  described  by  R.A. 
Wehage ,  E.J.  Haug,  Jr.,  and  R.C.  Huang  [1,  10]; 

DADS-3D  (Dynamic  Analysis  of  Dynamic  Systems),  described  by  R.C. 

Huang  and  E.J.  Haug,  Jr.  [1]; 

In  addition  to  the  above,  there  are  special  purpose  programs  that  can 
analyze  only  open  loop  systems.  These  include: 

AAPD  (Automated  Assembly  Program) ,  a  program  for  3  dimensional 
mechanisms,  is  described  by  Langrana  and  Bartel  [11] .  Only  revolute  and 
spherical  pairs  are  allowed. 

UCIN,  developed  by  Houston  et  al.  at  the  University  of  Cincinnati, 
is  for  strictly  open  loops  [12] . 

Loop  Closure  Technique 

Loop  closure  techniques  essentially  make  use  of  the  fact  that  the 
product  of  transformation  matrices  around  a  closed  loop  is  the  identity 
matrix.  Consider,  for  instance,  a  simple  4-bar  mechanism. 


Similarly,  in  reference  frame  (C^*  n^) 


[Pi. 


C:;]- 


(1.3.3) 


where  (T23)  is  the  rotational  matrix  from  reference  frames  2  to  3. 

In  reference  frame  (£.,  n.) 

4  4 


[PL 


V 

Lnp4, 


(T34) 


4P3 

Lnp3. 


(1.3.4) 


where  (T^)  is  the  rotational  matrix  from  reference  frames  3  to  4. 
Finally, 


[P] 


5  . 

P“ 

5 

pl 

P4 

«  (T  ) 

5  ,  u4r 

h  , 

-P1. 

L  p4J 

(1.3.5) 


where  (T^)  is  the  rotational  matrix  from  reference  frames  4  to  1. 
From  equations  (1.3.1)  to  (1.3.5),  one  has 


[P]1  "  (T41)(T34)(T23)(T12)  [P]1  (1.3.6) 

Since  P  is  chosen  arbitrarily,  (1.3.6)  implies  that 

(T41)(T34)(T23)(T12)  "  [I]  (1.3.7) 

Considering  the  first  variation  of  equation  (1.3. 7) ,  an  iterative  technique 
can  be  developed.  Beginning  with  an  initial  estimate  of  the  angles  and  positions 
of  each  joint,  a  solution  can  be  generated  such  that  (1.3.7)  holds  for  each 
Independent  loop  in  the  system. 
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There  are  three  basic  disadvantages  in  using  the  loop  closure: 

(a)  The  method  is  applicable  only  if  a  closed  loop  exists.  If  there 
are  no  closed  loops,  imaginary  links  and  joints  must  be  incorporated  into 
the  system,  without  changing  the  kinematics  of  the  system.  This  normally 
leads  to  unnecessary  complexities  in  the  completion  of  loops  and  unnecessary 
computations  as  far  as  the  basic  problem  itself  is  concerned. 

(b)  The  equations  to  be  solved  are  highly  nonlinear  in  nature  and, 
even  though  they  are  few  in  number,  convergence  might  be  rather  slow. 

(c)  The  program  needs  to  have  the  capability  of  recognizing  independent 
loops  in  the  mechanism  and  selecting  the  best  set  of  loops,  to  optimize 
computational  errors. 

Programs  which  use  the  loop  closure  technique  include  IMP,  DRAM, 
and  DYMAC. 

In  contrast,  programs  like  ADAMS,  DADS-2D,  and  DADS-3D 
utilize  a  sparse  matrix  approach,  to  be  presented  later,  which  leads  to  a 
large  number  of  loosely  coupled  equations  that  are  to  be  solved. 

These  programs  are  equally  efficient  with  closed  and  open  loop  mech¬ 
anisms. 

1.4  Organization  of  the  Report: 

Before  dealing  with  the  problem  at  hand,  it  is  essential  to  know  how 
the  DADS  -2D  code  works,  so  that  one  may  understand  precisely  what  modi¬ 
fications  are  necessary  to  use  it  effectively  for  kinematic  analysis. 

Chapter  2  is,  therefore,  utilized  for  explaining  the  fundamentals  of 
this  approach.  Only  the  most  basic  aspects  will  be  discussed  here.  The 
reader  is  referred  to  Ref.  [1]  for  details  of  the  method. 

Chapter  3  deals  with  the  proposed  method  of  analysis  of  kinematically 


determinate  systems 
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Chapter  4  contains  a  description  of  the  analysis  procedure  for  force 
driven  systems. 

Chapter  5  contains  the  implementation  of  the  method,  a  discussion  of 
the  computer  code  used,  and  briefly  explains  the  computational  flow  in  the 
program. 

In  Chapter  6,  numerical  results  for  several  problems,  obtained  by  the 
above  method  are  discussed,  conclusions  are  presented  and  promising 
directionsfor  future  effort  in  this  field  are  discussed. 
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CHAPTER  2 

An  Overview  of  the  DADS  Program 


2.1 

Any  rigid  body  undergoing  planar  motion  can  be  uniquely  fixed  in 
space  by  specifying  three  coordinates  with  respect  to  a  Newtonian 
reference  frame.  The  simplest  set  of  suitable  coordinates  is  the  Cartesian 
X,Y  coordinate  of  some  point  on  the  body  e.g.,  the  center  of  mass,  with 
respect  to  the  reference  frame,  and  a  <j>  coordinate  that  defines  the 
rotation  of  any  line  on  the  body  with  respect  to  its  initial  time,  as  shown 
in  Fig.  2.1.  Attached  to  each  body  is  another  frame  of  reference  (0^,  n^) 

that  is  used  for  the  purpose  of  locating  fixed  points  on  that  body. 

A  mechanical  system  consists  of  several  such  rigid  bodies  connected 
by  means  of  joints  and  springs.  Joints  constrain  the  motion  of  the  body 
on  which  they  are  located  and  springs  introduce  internal  forces  into  the 
system. 

Two  types  of  joints,  the  revolute  joint  and  the  translational  joint, 
are  included  in  the  formulation  [1],  The  DADS-2D  program  [1],  however,  is 
versatile  enough  to  allow  the  user  to  insert  non-standard  joints  such 
as  cams  and  other  higher  pair  joints. 

Since  mathematical  equations  can  be  written  for  each  constraint  in  the 
system,  the  problem  of  dynamic  analysis  of  a  constrained  mechanical  system 
reduces  to  solving  the  equations  of  motion  corresponding  to  each  generalized 
coordinate,  subject  to  constraints  imposed  on  the  motion  by  the  joints. 

Suppose  that  there  are  *n'  bodies  in  an  arbitrary  mechanical  system  and  that 
they  are  subjected  to  '2m'  constraints.  Corresponding  to  each  body,  there 
are  three  degrees-of-freedom;  so  in  total,  there  are  3n-generalized 


coordinates  making  up  the  system,  denoted  by  q  £  R  .  These  coordinates  are 
not  independent,  however,  since  they  must  satisfy  the  equations  of  constraint 


(q)  *  o 


(2.1.1) 


where  $  €  R2m,  and  ’m'  is  the  total  number  of  joints  in  the  system. 

The  equations  of  motion,  derived  from  the  variational  form  of  Lagrange's 
equations  [14],  can  be  written  as 


(2.1.2) 


where  represent  all  conservative  and  non-conservative  forces  acting  in 
the  q^  direction. 

The  equations  of  motion  (2.1.2)  must  hold  for  all  time  and  for  all 
virtual  displacements  6q^  that  are  consistent  with  the  constraints  (2.1.1), 
i.  e. 


(2.1.3) 


By  the  Farkas  Lemmas  of  optimization  theory,  there  exist  multipliers 
X,  X  e  R2m,  such  that 


(2.1. 


for  all  6qi . 


Thus,  one  obtains  the  equations 
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(2.1.5) 

(2.1.6) 


One  therefore  has  a  set  of  (3n  +  2m)  equations  in  (3n  +  2m)  variables 
q  and  A.  This  is  a  coupled  set  of  differential  and  algebraic  equations 
that  must  be  solved  simultaneously. 

2.2  Integration  of  the  Equations  of  Motion: 

The  equations  of  equilibrium  are  second-order,  nonlinear,  ordinary 
differential  equations,  which  can  be  expressed  in  the  form 


g(  q,  q,  q.  A,  t) 


0,  g  €  R 


3n 


(2.2.1) 


Introducing  a  new  variable  u,  such  that  one  has 

(2.2.2) 

(2.2.3) 


u  -  q  ■  0 
u  -  tj  «  0 


The  equations  of  motion  can  now  be  written  as 

g1(q,  u,  u.  A,  t)  -  0,  gx  e  R6"  (2.2.4) 

which  are  first-order  and  more  easily  adaptable  for  computer-aided  methods 
of  solution.  The  numerical  algorithm  used  in  the  DADS-2D  program  is  Gear's 
Stiff  Integration  Algorithm.  Essentially,  this  algorithm  replaces  the  time 
derivatives  of  the  generalized  coordinates  at  each  time  step  by  a  polynomial 
approximation,  using  the  values  of  the  variable  and  its  derivative  at  the 
present  and  previous  R  time  steps.  Once  the  replacement  is  done,  the  problem 
simplifies  to  a  system  of  algebraic  equations,  which  is  solved  by  the  Newton- 
Raphson  iteration  scheme  [1]. 
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2.3  Sparse  Matrix  Algebra; 

One  could  theoretically  solve  the  above  problem  by  eliminating  the 
dependent  generalized  coordinates  from  the  system  of  equations  and  reducing 
the  size  of  the  system.  This  technique,  however,  leads  to  a  greater  degree 
of  coupling  between  the  remaining  equations,  which  also  tend  to  become 
very  nonlinear.  With  the  formulation  presented  in  the  preceding  section,  the 
equations  are  very  ’'o^sely  coupled  because  instead  of  solving  a  system  of 
(3n  4*  2m)  equations,  system  of  (6n  +  2m)  equations  is  being  solved.  There¬ 
fore,  while  performing  the  Newton-Raphson  iterations,  one  is  confronted  with 
a  large  matrix  in  vSich  most  of  the  elements  are  zero.  The  locations  of 
the  non-zero  elements  and  their  values  can  be  easily  determined,  once  the 
topology  of  the  system  is  known.  As  long  as  the  topology  does  not  change, 
their  locations  also  do  not  change. 

Sparse  matrix  algorithms  designed  to  take  maximum  benefit  of  the 
sparsity  of  the  matrices  involved  can  be  put  to  good  use  here.  A  substantial 
saving  in  core  storage  is  realized,  since  the  values  of  the  nonzero  entries 
and  their  row  and  column  addresses  can  be  easily  stored  in  three  vectors  of 
small  dimension. 

In  the  DADS- 2D  program  [1] ,  the  Harwell  library  of  sparse  matrix 
subroutines  is  used.  They  perform  a  symbolic  LU  factorization  of  the  matrices 
involved  using  a  partial  pivoting  technique  that  maintains  a  high  degree  of 
sparsity  in  the  L  and  U  matrices.  The  variables  are  then  determined  by  a 
simple  forward  and  backward  substitution  procedure. 

No  effort  is  made  here  to  explain  the  intricate  computational  details 
involved  in  the  DADS-code;  rather  the  emphasis  here  is  on  the  use  of  the  solution 
technique  for  the  kinematic  and  equilibrium  problem. 

For  a  more  detailed  discussion,  the  reader  is  referred  to  references 


1  and  2 
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2. A  Equations  of  Constraint: 

Figure  2.2  depicts  two  adjacent  bodies  1  and  j.  The  origins  of  their 
body  fixed  coordinate  systems  are  located  by  the  vectors  and  Rj  with 
respect  to  the  inertial  frame  of  reference.  Let  an  arbitrary  point  p^ 
on  body  i  be  located  by  r^  and  p  ^  ^  on  body  j  be  located  by  r^.  These 
points  are,  in  turn,  connected  by  a  vector  r^.  One  can  write  a  vector 
equation  beginning  at  the  origin  of  the  Inertial  reference  frame  and  closing 
there,  to  obtain  the  vector  relationship: 


Ri +  ru  +  'p  '  rji '  " 0  <2-4-1) 

The  constraint  equations  for  a  revolute  joint  are  now  obtained  by 


requiring  that  p  and  ^  coincide.  Setting  rp  =  0  and  writing  Eq.  2.4.1  in 
component  form,  one  has 


COS  4^  - 

nij 

sin 

COS 

+  sin 

-  0 

+  cij 

sin  4>^  + 

nij 

cos  -  Tj  -  Sjj 

sin 

-  cos 

-  0 

For  a  translational  joint  shown  in  Figure  2.3,  let  points  p^  and  p^ 
lie  on  some  line  parallel  to  the  path  of  relative  motion  between  two  bodies. 
In  addition,  let  them  be  located  such  that  r^  and  r^  are  perpendicular  to 
this  line  and  of  nonzero  magnitude.  Successively  forming  the  dot  product  of 
Eq.  2.4.1  with  r^  and  r^  and  adding,  one  obtains  the  scalar  equation 

-  7«  •  v +  rij +  7u  •  <W +  7ji  •  7y  -  rsl + 7ji  •  (Vy 


(2.4.3) 


which  reduces  to 


cos  *1  -  sin  d>±  +  C  cos  4^  -  sin  4^)^  -  Xj) 

+  Sin  <P1  +  COS  ^  sin  4^  +  cos  )  Cy±  -  yj ) 

2  2  2  2 
+  Cij  +  nij  ~  5ji  “  nji  “ 


0 


(2.4.4) 


Translational  Joint 


Figure  2.3 
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A  second  scalar  equation  is  obtained  by  noting  that  r  x  rji  =  0*  Expansion 
of  the  cross  product  yields  only  a  z  component,  which  must  be  zero.  This  is 

(5  cos  <J>  -  n..  sin  $,)(£..  sin  <p ,  +  n..  cos  <p.) 

il  i  il  i  li  1  li  j 

-  (C^  cos  (|i sin  40(5^  sin  ^  cos  =  0  (2.4.5) 

Spring-Dampers:  Since  springs  and  dampers  generally  appear  in 

pairs,  they  are  incorporated  into  a  single  set  of  equations.  If  one  or  the 
other  is  absent,  its  effect  is  eliminated  by  setting  that  term  to  zero.  The 
equations  for  spring-damper  force  and  torque  are 


r 


Fu 


. (i,  .  -  )  +  c  v  +  F- 

i!  il  0tj  ij  il  0±j 


ij 


(2.4.6) 


hj  ‘  \  <*« 


V  +  +  \ 


(2.4.7) 


where 


ij 


is  the  resultant  force  vector  [F  ,  F  ]  in  the  spring- 


damper 


ij  ij 


’ij 


ij 

^ij 


'ij 


ij 


is  the  vector  cos  a,  4  sin  a]  between  points  S^  and 

Sj ^  of  a  spring-damper  connection  on  the  two  bodies,  as  in 
Fig.  2.4 

is  the  torque  acting  on  two  bodies  at  a  revolute  joint 
and  k  are  elastic  spring  coefficients 

rij 

and  c  are  damping  coefficients 

rij 

and  <j)  are  the  undeformed  spring  length  and  angular  rotation 

°ij 

in  the  revolute 


ij 


and  #  are  the  deformed  spring  length  and  the  angular  rotation 
in  the  revolute,  and  and  $  are  the  time  derivatives  of 

'13  “d  *lj 
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Linear  Spring,  Damper  and  Actuator 
Figure  2.4 
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Fq  and  Tq  are  constant  forces  and  torques  applied  along  the 
Uij  Uij 

spring  and  around  the  revolute  joint  between  two  bodies 
From  Figure  2.4,  a  vector  expression  similar  to  Eq.  2.4.1  is  written  as 


R.  +  r  +  R  -r  -R.  =  0 

1  S  .  .  S  .  .  S  .  .  1 

IJ  IJ  J 1 


or  in  component  form 


s .  . 

ij 


i . .  cos  a 
ij 


l.  .  sin  a 
ij 


Lyi 


5  cos  -  n  sin  d> . 
s .  .  i  s ,  .  l 

ij  ij 


£  sin  ij) .  +  q  cos  <p , 
s .  .  l  s ,  .  i , 

ij  ij 


yj 


£  cos  <p .  -  n  .  sin  4. 
SJi  J  SJi  J 


C  sin  <j> .  +  n  cos  <f> . 

■  Sji  3  sji  J. 


(2.4.8) 


where  a  is  the  angle  between  R  and  the  inertial  x  axis.  Equation  2.4.8 

Sij 

is  used  to  obtain  l  by  noting  that 

2  2  1/2 
l..  -  [(£■..  cos  a)  +  (l..  sin  a)  ] 
ij  ij  ij 

*  [(-x,  -  £  cos  <|> .  +  n  sin  <t>.  +  x.  +  5  cos  <j> . 

1  s . .  l  s . .  i  j  s .  .  1 

ij  ij  J  i 

2 

-  n  sin  <f>.)  +  (-  y.  -  £  sin  <t>,  -  n  cos  <p, 

S]L  1  1  “ij  1  “ij  1 

2  1/2 

+  y,  +  ?  sin  +  n  cos  '  (2.4.9) 

j  J  sjl  j  ] 

Substituting  the  left  side  of  Eq.  2.4.8  into  Eq.  2.4.6  the  following  force 
expressions  are  obtained 


]  F^j |  cos  a 


F  ■  I F, ,  sin  a 
yij  lj 

where  cos  a  and  sin  a  are  obtained  by  dividing  Eq.  2.4.8  by  £ 
defining 


ij' 


(2.4.10) 

(2.4.11) 
Finally, 


Vij  “  ‘ij 


(2.4.12) 


» 


and  transfering  i  ,  F  ,  F  ,  and  v  to  the  right  hand  sides  of 
3  ij  yij  iJ 

2.4.9  and  2.4.12,  one  obtains  equations  in  the  form  required  by  the 
integration  algorithm. 


Eqs. 

numerical 
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CHAPTER  3 

Proposed  Method  of  Analysis 

There  exist  two  broad  categories  of  analysis,  for  which  the  methods 
of  solutions  are  radically  different.  These  are: 

(a)  kinematically  driven  systems. 

(b)  force  driven  systems. 

In  a  kinematically  driven  system,  the  input  is  a  kinematic  relationship 
that,  with  the  equations  of  constraint,  specifies  q.  For  instance,  a 
particular  generalized  coordinate  specified  as  a  function  of  time  could 
constitute  a  kinematic  input.  As  time  varies,  the  function  changes  its 
value.  Thus,  the  system  assumes  a  new  configuration.  In  such  a  system, 
one  assumes  implicitly  that  the  forces  necessary  to  effect  such  an  input 
are  available. 

In  such  a  system,  as  will  be  demonstrated  later,  the  equations  of 
equilibrium  and  equations  of  constraint  are  completely  decoupled  and  the 
generalized  coordinates  can  be  computed  directly  from  the  constraint  equations. 
Once  these  have  been  computed,  velocities,  accelerations,  and  Lagrange 
Multipliers  can  be  computed  algebraically. 

In  a  force  driven  system,  forces  are  used  as  inputs.  Since  the  effect 
of  these  forces  on  the  generalized  coordinates  are  not  known  a  priori,  the 
equations  of  equilibrium  are  coupled  with  the  constraint  equations  so  that 
they  have  to  be  solved  simultaneously  to  yield  the  Lagrange  Multipliers  and 
the  state  variables. 

Analysis  of  Kinematically-Determined  Systems 
3. 1  Solution  for  State  Variables: 

The  analysis  scheme  presented  here  is  valid  for  kinematically  determinate 
systems  only.  For  a  system  with  n  bodies  and  m  joints,  one  may  write  2m 


equations  of  constraint  from  equations  (2.4.2),  (2.4.4),  and  (2.4.5). 
There  are,  thus 
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f  =  3n  -  2m  (3.1.1) 

kinematic  degrees  of  freedom,  since  the  constraint  equations  are  independent. 
Denoting  the  generalized  coordinates  by  the  vector  q,  q  e  R^n,  one  has  the 
vector  of  constraint  equations 

?i(q)  -  0,  6  R2n 

In  kinematic  analysis,  one  may  specify  £  relationships  among  the 
generalized  coordinates,  in  terms  of  an  input  parameter  a 

Thus,  one  has  £  additional  independent  constraints  of  the  form 

<j>2(q,  a)  "  0,  $2  £  R*  (3.1.2) 

Since  for  a  kinematically  determinate  system, 

£  +  2m  »  3n 

one  has  a  situation  in  which  the  number  of  equations  is  exactly  equal  to 
the  number  of  variables.  Quite  often,  the  parameter  a  is  scalar  time. 


Figure  3.1 

As  an  illustration,  consider  the  4-bar  crank-rocker  mechanism  shown 
in  Figure  3.10  that  is  used  as  the  oscillating  mechanism  in  fans.  It  consists 
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of  4  bodies,  4  revolute  joints  and  one  Input  relationship 

$2  “  <)>2 (  »)  (3.1.3) 

Body  1  is  fixed  to  the  Newtonian  Reference  Frame. 

Number  of  generalized  coordinates  =  4  x  3  =  12 

Number  of  constraints  due  to  joints  =4x2*  8 

Number  of  constraints  introduced  by  fixing  body  1  =  3 

Number  of  input  relationships  =  1 

The  input  relationship  can  be  thought  of  as  a  constraint,  since  it 
actually  constrains  the  rotation  of  body  2.  Thus,  one  has  12  variables  and 
12  constraints  involving  the  variables.  There  is  here  one  input  parameter 
that  can  be  varied  continuously  to  change  the  configuration  of  the  system. 

Letting  the  vector  4>  c  R^n  represent  the  composite  set  of  equations, 
one  can  write 


(  q ,  at)  = 


$x(q) 

0 

<t>2(q.a) 

0 

—  - 

From  the  implicit  function  theorem  of  calculus,  the  matrix 


(3.1.4) 


3n  x  3n 


is  required  to  be  non-singular  for  a  solution  to  exist. 

The  set  of  3n  equations  (3.1.4)  is  solved  by  the  Newton  Raphson  for  q, 
once  a  is  fixed.  Given  an  initial  estimate  q*,  it  is  required  to  find  Aq*, 
such  that  qi+^  *  q"*"  +  Aq*  is  a  better  approximate  solution  of  equation  (3.1.4), 
written  now  as 

4>(q1+1,  a*)  =  0  (3.1.5) 

the  asterisk  being  a  reminder  that  the  value  of  a  is  fixed. 
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From  the  Taylor  expansion  of  (3.1.5),  upto  first  order,  one  has 

0 


$(q1+1,  a*) 


♦ci.  ■>*>  -1 


(3.1.6) 


or 


-  $(q  ,  a*) 


(3.1.7) 


This  equation  is  linear  in  Aq  and  can  be  conveniently  solved  by  using  an 
LU  factorization  scheme.  Let 


Therefore, 


(l±  (q*,  a*)) 

V*  J 


LU 


(D(U)Aq1  -  -  <j>(q*,  a*) 


(3.1.8) 


Let 


/t.i  i  _  3n 

(U)  Aq  =  v,  v  €  R 


(3.1.9) 


Then, 

Lv  -  -  4>  (q1,  a*)  (3.1.10) 

The  vector  v  can  be  easily  determined  by  a  forward  substitution  procedure. 
Replacing  the  computed  values  for  v  in  (3.1.9),  Aq*  is  computed  by  a  back¬ 
ward  substitution  and  the  new  estimate  q*+*  is  found.  This  iteration 
process  is  repeated  until  Aq*  satisfies  the  error  tolerance  specified. 

3.2  Computation  of  Velocities: 

The  input  parameter  a  may  be  related  to  time,  and  in  some  cases  it  may  be  time 
itself.  In  such  a  case,  the  generalized  velocity  can  be  easily  computed. 

Differentiating  the  constraint  equations  (3.1.4)  with  respect  to  time, 
one  has 


0 


(3.2.1) 
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(3.4.1) 
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In  matrix  notation,  (3.4.1)  simplifies  to 


X  -  g(Q,q,q,q) 


(3.4.2) 


Since  (3 <J> / 3 q )  *  LU,  one  notes  that 


T  T 

Since  L  and  U  are  known,  L  and  U  are  also  known  and  thus  (3.4.2),  which  is 

linear  in  X,  can  be  solved  to  give  the  Lagrange  Multipliers. 

3. 5  Analysis  of  Systems  with  Springs,  Dampers  and  Actuator  Forces: 

Inclusion  of  springs,  dampers  and  actuator  forces  in  a  kinematically 

driven  system  does  not  pose  any  additional  computational  problems.  Since 

•  •• 

the  values  of  the  state  variables  q,  q,  and  q  are  governed  completely  by 
the  constraint  equations,  they  are  obviously  not  affected  by  the  inclusion 
of  springs  and  dampers.  The  Lagrange  Multipliers,  however,  do  change  with 
the  inclusion  of  springs  and  actuators,  since  they  introduce  internal  forces 
into  the  system. 

Since  one  already  knows  the  state  variables  before  computing  the  Lagrange 
Multipliers,  the  forces  due  to  springs,  dampers,  and  actuators  can  be 
computed  for  each  analysis  step.  Referring  specifically  to  (3.4.1),  the 
,  which  originally  might  have  consisted  of  constant  forces,  now  become 


functions  of  the  state  variables.  Thus,  only  Q  in  the  right  hand  side  of 
(3.4.1)  needs  to  be  modified  to  include  spring-damper  effects.  The  computa¬ 
tional  procedure  need  not  change  at  all. 
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CHAPTER  4 

Equilibrium  in  Force  Driven  Systems 

The  analysis  of  forced  driven  systems  essentially  follows  the  same 
procedure  as  transient  dynamic  analysis.  Since  the  effect  of  the  force 
inputs  on  the  generalized  coordinates  cannot  be  determined  without  solving 
the  equilibrium  equations,  the  system  of  constraint  equations  and  equili¬ 
brium  equations  are  coupled  and  must  be  solved  simultaneously. 

However,  there  is  one  major  difference  in  the  procedures  adopted  for 
transient  dynamic  analysis  and  for  equilibrium  of  force  driven  kinematic 
anlysis.  The  difference  is  that  there  are  no  differential  equations  to 
solve  in  the  equilibrium  problem.  In  kinematic  analysis,  one  assumes  that 
initial  forces  and  velocity  effects  are  negligible;  hence,  the  equilibrium 
equations  are  algebraic.  This  in  itself  may  seem  to  be  only  an  academic 
difference,  but  the  fact  is  that  the  numerical  algorithm  becomes  much 
more  stable  and  efficient.  This  is  because  a  system  of  simultaneous  alge¬ 
braic  and  differential  equations  tends  to  behave  like  a  set  of  stiff  differential 
equations.  Because  of  this,  the  integration  algorithm  is  forced  to  take  small 
time  steps  to  obtain  convergence  of  the  solution  in  each  period  of  time. 

Once  the  inertial  and  velocity  effects  are  removed  the  apparent  stiff¬ 
ness  disappears,  because  what  remains  is  an  algebraic  nonlinear  set  of  equations. 

Springs  and  dampers  must,  however,  be  treated  differently  in  this 
formulation,  as  compared  to  a  kinematically  driven  system.  The  effect  of 
springs  and  dampers  are  not  known  a  priori,  since  the  state  variables  and 
Lagrange  Multipliers  are  computed  simultaneously.  One  possible  way  to 
alleviate  this  problem  is  to  define  each  spring  force  as  a  generalized 
coordinate.  Corresponding  to  each  spring  force,  a  'constraint'  equation 


defining  it  in  terms  of  the  other  generalized  coordinates,  is  added  to  the 
Jacobian  matrix. 
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In  the  method  presented  here,  the  equations  of  equilibrium  are  modified 
to  include  the  yet  undetermined  effects  of  the  spring  forces,  and  during  the 
Newton  iterations  all  state  variables  and  unknown  multipliers  are  simul¬ 
taneously  computed. 

Neglecting  inertial  and  velocity  effects  from  (2.1.5),  one  has  the 
equilibrium  equations 


i*l. . . 3n 


(4.1.1) 


the  representing  all  external  forces  as  well  as  the  internal  forces 
generated  by  springs  and  actuator  forces.  Since  velocity  effects  are 
neglected,  dampers  are  not  considered  in  this  formulation. 

Equations  (4.1.1)  must  be  solved  in  conjunction  with  the  constraint 
equations 


i(q)  ■  0 


(4.1.2) 


Equation  (4.1.1)  is  linear  in  the  Lagrange  multipliers,  but  both 
equations  (4.1.1)  and  (4.1.2)  are  nonlinear  in  the  generalized  coordinate 
q,  hence,  an  iterative  technique  is  needed  to  obtain  a  solution  of  the 
system  of  algebraic  equations.  Once  again,  the  Newton-Raphson  iteration 
scheme  is  used.  At  each  analysis  step  of  this  iteration  scheme,  one  solves 
a  linearized  version  of  equations  (4.1.1)  and  (4.1.2).  Linearizing  these 
equations,  one  obtains 


(4.1.3) 


'  4 
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and 


-MqS 


(4.1.4) 


Rewriting  equations  (4.1.3)  and  (4.1.4)  in  a  compact  matrix  form,  one 


Using  an  initial  estimate  of  the  q's  and  A's,  one  solves  equation  (4.1.5) 
to  obtain  the  optimal  increments  in  the  variables  and  substitutes  them  into 
(4.1.6)  to  generate  the  updated  values.  Iterations  are  continued  by  solving 
(4.1.5)  again  and  the  whole  process  is  repeated  until  AX  and  Aq  satisfy 
error  tolerances. 

In  the  actual  computational  method  used  in  the  program,  the  matrix  of 
equation  (4.1.5)  is  not  evaluated  at  each  step.  Several  iterations  are  done 
using  the  same  matrix  but  with  an  updated  right  hand  side,  before  the  values 
of  the  entries  are  changed. 

While  this  may  decrease  the  rate  of  convergence  to  some  extent,  the 
savings  in  cost  realized  by  not  re-evaluating  the  matrix  is  large  enough  to 
offset  the  expenses  due  to  increased  number  of  iterations. 
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CHAPTER  5 

Organization  of  the  Computer  Code 

The  DADS-2D  code  essentially  consists  of  a  set  of  subroutines, 
each  of  which  performs  a  specific  function.  The  program  is  thus  modularized 
so  as  to  make  it  as  general  as  possible  and,  at  the  same  time,  make  it 
amenable  to  modifications. 

As  input  to  the  program,  the  following  details  have  to  be  supplied: 

(a)  System  Parameters:  amount  of  diagnostic  information  to  be  printed, 
error  tolerances,  time  of  simulation,  the  a  grid  interval,  and  the  system  of 
units  to  be  used. 

(b)  Initial  Estimates:  of  the  x,  y,  and  d>  coordinates  of  each  body 
fixed  frame  of  reference  with  respect  to  the  global  frame  of  reference. 

(c)  Body  Information:  including  mass,  moment  of  inertia  about  the 

center  of  mass,  and  constant  forces  and  torques  acting  at  the  body  center 
of  mass. 

(d)  Joint  Information:  which  includes  the  bodies  connected  by  each  joint  and 
the  coordinates  of  the  joint  relative  to  the  body-fixed  axes  on  the  connected  bodies. 

(e)  Spring  Information:  consisting  of  the  two  bodies  to  which  each 
spring  is  attached,  attachment  points  on  the  two  bodies,  spring  constants 
and  free  lengths  of  the  springs. 

In  addition,  provision  is  made  to  specify  curves  as  a  discrete  set 
of  points.  The  program  then  constructs  a  third-order  spline  through  these 
points  to  generate  an  analytical  function. 

The  main  computational  flow  of  the  program  is  shown  in  Figure  (5.1.1) 
and  a  detailed  list  of  subroutines  used  is  shown  in  Figure  (5.1.2).  A 
detailed  list  of  the  various  subroutines  used  and  a  brief  explanation  of 
their  functions  is  listed  below. 
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SUBROUTINE 

1)  XECUTE 

2)  DADSP1 

3)  INDATA 

4)  SETJT1,  SETJT2, 
SETJT3,  SETJT4 

5)  INDSET 


6)  INDXC1,  INDXC2 
INDXC3,  INDXC4 

7)  UINDST 

8)  ASEMBL 


FUNCTION 

Calculates  dimensions  of  the  main  arrays 
Main  driving  subroutine.  Controls  the 
entire  program  by  calling  the  other  sub¬ 
routines 

Secondary  driving  subroutine,  calls  all  the 
'SET'  subroutines  which  read  all  the  input 
data 

Read  input  data  corresponding  to  revolute 
joints  (JT1),  translational  joint  (JT2) , 
rev-rev  joint  (JT3) ,  and  rev-tran  joint 
(JT4) ,  respectively 

Secondary  driving  subroutine,  calls  all 
INDX  subroutines  which  generate  the  row 
and  column  indices  of  the  non-zero  entries 
in  the  Jacobian 

Generate  row  and  column  pointers  corres¬ 
ponding  to  the  constraints  introduced  by 
Joints  type  1,2,3,  and  4,  and  also  the 
equations  of  motion 

Generates  row  and  column  pointers  for  the 
user  supplied  constraints 

Corrects  input  data  to  satisfy  the  constraint 
equations  and  equations  of  motion 
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SUBROUTINE 
9)  MFEVAL 


10)  MFJNT1,  MFJNT2 
MFJNT3,  MFJNT4 


11)  UMFEVL 


12)  SOLVJM 


13) 

MC19AD, 

MC19BD, 

MAI 3  AD 

MC29AD, 

MC29BD, 

MC29CD 

MA30AD 

14) 

DFASUB 

15)  EQUIL 

16)  SPLINE  {FUNCTION) 


FUNCTION 

Secondary  driving  subroutine,  calls  other 
MFJ...  subroutines  which  evaluate  the  non¬ 
zero  entries  in  the  Jacobian  matrix 
Evaluate  the  non-zero  entries  introduced 
by  the  constraints  due  to  the  joint  types 
1,2,3,  and  4 . 

Evaluates  non-zero  entries  due  to  user 
supplied  constraints 

Secondary  driving  subroutine,  calls  the 
sparse  matrix  subroutines,  performs  forward 
and  backward  substitutions  in  the  Newton 
Raphson  iterations 
Sparse  matrix  subroutines 


The  subroutine  which  controls  all  numerical 
computations,  checks  if  error  criteria  are 
satisfied,  predicts  values  at  next  time  step 
by  extrapolation  techniques,  prints  the  results 
Calculates  the  Q  vector  used  for  solving  the 
Lagrange  multipliers 

Civen  a  set  of  data  points,  the  function 
calculates  a  cubic  spline  through  them.  In 
addition,  it  computes  its  first  and  second 


derivatives 
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CHAPTER  6 
Example  Problems 

The  purpose  of  this  section  is  to  demonstrate  the  feasibility 
of  the  preceding  method  by  solving  example  problems.  Three  kinematically 
determinate  systems  are  analyzed,  each  of  increasing  complexity,  and 
numerical  results  are  shown.  In  addition,  a  simple  force  driven  mechanism 
was  analyzed. 

6.1  Sample  Problem  1;  Slider  Crank 

The  slider  crank  has  been  chosen  as  the  first  example  because  it 
incorporates  all  the  standardized  elements  of  the  code.  Body  1  is  the  fixed 
body  or  'earth'.  Body  2  is  the  crank,  body  3  is  the  coupler  link  and  body 
4  is  the  slider,  which  slides  on  a  fixed  guide  on  body  1.  Crank  member  2  is 
given  an  input 

4>2  ( t )  -  |  +  e/2.00 

where  t  represents  time.  Attached  to  revolute  joint  RVLT2  is  a  torsional 
spring  TS1,  and  between  bodies  4  and  1,  a  linear  spring  LSI.  It  is  attempted 
to  compute  the  generalized  coordinate  and  the  Lagrange  multipliers  as  functions 
of  time.  The  input  data  for  the  problem  are  shown  in  Table  6.1.1. 

The  simulation  was  done  using  an  ITEL  AS-8  computer.  All  computations 
were  done  in  double  precision  and  the  program  was  run  using  a  VIATFIV  compiler. 
The  simulation  period  was  10.0  seconds  and  a  solution  was  forced  every  0.1 
seconds.  Compiling  time  was  3.43  seconds,  execution  time  was  53.29  seconds, 
and  the  total  cost  of  the  run  was  $18.52. 


Slider  Crank  Mechanism 
Figure  6.1.1 


Table  6.1.1 


0.78539  -0.7854  24.995 


'cr 

-a- 

co 

<r 

*3 

-3 

>3- 

in 

n 

>3 

>3- 

-3 

-3- 

CM 

<3 

sj- 

x3 

-3 

o 

o 

© 

c 

O 

o 

o 

o 

O 

O 

o 

o 

O 

o 

o 

O 

o 

o 

o 

o 

D 

Q 

Q 

o 

Q 

a 

Q 

Q 

a 

Q 

o 

a 

Q 

Q 

Q 

a 

a 

Q 

Q 

a 

rH 

co 

rH 

CM 

NO 

co 

ON 

00 

r-x 

»H 

co 

o 

O 

nD 

r- 

00 

in 

in 

x3 

<T 

r-x 

00 

co 

ON 

co 

ON 

O' 

ON 

o 

O 

rH 

nO 

vj 

CM 

in 

r- 

NO 

00 

00 

nO 

O 

O 

c*- 

r*x 

m 

o 

O' 

co 

o 

o 

vO 

NO 

rH 

rH 

r*x 

n 

00 

in 

r*- 

o 

NO 

m 

CsJ 

co 

NO 

r-*- 

O' 

rH 

IH 

ON 

00 

px 

in 

CM 

CM 

CM 

in 

r-x 

ON 

O 

o 

O 

o 

I 

d 

i 

o 

1 

O 

1 

o 

( 

o 

l 

o 

1 

d 

i 

o 

i 

O 

t 

o 

o 

> 

o 

i 

C 

o 

o 

d 

CM 

ro 

co 

CO 

CO 

co 

CO 

co 

CO 

CO 

CO 

CO 

CO 

CO 

o 

CM 

CM 

CM 

CM 

CM 

CM 

o 

O 

o 

O 

o 

o 

o 

o 

O 

O 

o 

o 

o 

o 

O 

o 

o 

o 

o 

c 

Q 

Q 

a 

a 

a 

a 

a 

a 

a 

a 

a 

Q 

Q 

CO 

Q 

a 

Q 

a 

a 

a 

O 

o 

CO 

CO 

00 

o 

00 

rH 

ON 

ON 

in 

ON 

rH 

00 

rH 

rH 

in 

CM 

ON 

oo 

CO 

rH 

rH 

in 

ON 

ON 

<r 

co 

CO 

NO 

rH 

rH 

p- 

in 

00 

ON 

nO 

Is*- 

00 

in 

rH 

vO 

ON 

fH 

o 

o 

o 

ON 

CO 

r>- 

NO 

-3 

t—1 

NO 

o 

o 

00 

CO 

ON 

n 

rH 

H 

rH 

CM 

CM 

CM 

CM 

rH 

rH 

rH 

rH 

iH 

rH 

00 

n 

H 

CM 

n© 

ao 

o 

i 

o 

t 

o 

j 

o 

» 

O 

o 

vO 

1 

o 

1 

o 

1 

o 

i 

o 

1 

o 

1 

o 

i 

o 

i 

o 

1 

o 

i 

o 

1 

o 

o 

o 

co  co 

O  O 

q  a 

co  no 

on  m 

-3-  x3 


o 

i 

a 

e 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

1 

O 

© 

© 

o 

o 

© 

CM 

co 

CO 

co 

CO 

co 

CO 

CO 

CO 

CO 

co 

cO 

CO 

co 

CM 

CM 

CM 

CM 

CM 

CM 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

O 

o 

a 

a 

a 

a 

a 

a 

Q 

Q 

a 

a 

a 

a 

a 

a 

a 

a 

a 

a 

a 

a 

r-x 

o 

o 

CO 

CO 

CO 

O 

00 

rH 

ON 

ON 

in 

ON 

rH 

OO 

rH 

rH 

in 

CM 

ON 

co 

CO 

rH 

rH 

in 

ON 

ON 

*3 

00 

00 

NO 

rH 

rH 

in 

n 

ON 

NO 

00 

n 

rH 

ON 

o 

o 

c 

O 

ON 

oo 

r- 

NO 

-3 

rH 

NO 

o 

o 

oo 

co 

ON 

in 

rH 

rH 

rH 

CM 

CM 

CM 

CM 

rH 

rH 

rH 

rH 

rH 

rH 

CO 

n 

rH 

CM 

NO 

00 

o 

l 

o 

i 

o 

o 

\ 

o 

i 

o 

1 

d 

i 

d 

* 

O 

1 

o 

1 

o 

i 

o 

i 

O 

1 

O 

1 

d 

\ 

vO 

\ 

o 

1 

d 

o 

© 

in 

o 

in 

o 

in 

o 

in 

o 

in 

© 

in 

o 

• 

• 

• 

• 

• 

• 

• 

• 

• 

• 

• 

■ 

in 

n 

nO 

r*. 

rx 

00 

oo 

ON 

ON 

© 

rH 

LM2X  -  1  Lagrange  Multiplier  at  revolute  joint  2;  LM3Y  =  2  Lagrange  Multiplier  at  revolute  joint 

TABLE  6.1.2 


38 


( 


'EQ  MX 

02 

BO0 1 

0 

'EQHT 

02 

8002 

1 

'HQHPHI 

02 

BOO  3 

2 

:XACC 

02 

B004 

3 

4 

7 

8 

fT  ACC 

02 

B005 

5 

6 

9  A 

:  ALPHA 

02 

BC06 

B 

C 

F 

G 

’XTEL 

02 

R007 

D  E 

H  I 

:TBEL 

02 

B008 

J 

K 

N  C 

'OMEGA 

02 

B009 

L  H 

P  Q 

SEQHX 

03 

B010 

B 

8 

a  s 

’EQHT 

03 

B011 

X 

T 

T  0 

'EQHPHI 

03 

BG12 

Z 

Figure  6.1.2:  Matrix  of  First  Derivatives 
of  the  Constraint  Equation 
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The  rows  of  the  matrix  of  Fig.  6.1.2  represent  constraints  as  follows: 

R001,  R002  and  R003  are  constraints  obtained  by  fixing  body  1. 

ROOA  and  R005  are  constraints  obtained  due  to  RVLT1. 

R006  and  R007  are  constraints  obtained  due  to  RVLT2. 

R008  and  R009  are  constraints  obtained  due  to  RVLT3. 

R010  and  R011  are  constraints  obtained  due  to  TRAN1. 

R012  is  the  kinematic  constraint  imposed  on  the  rotation  of  the  body  2. 
Each  of  the  columns  represents  a  generalized  coordinate. 

Thus,  element  (8,7)  =  J  in  Fig.  6.1.2  represents  the  partial  derivative 
of  R008  with  respect  to  X^,  i.e.,  the  partial  derivative  of  the  first  constraint 
due  to  RVLT3,  with  respect  to  X^. 

6.2  Example  Problem  2:  Peaucellier  Lipkin  Exact  Straight  Line  Mechanism 

Figure  6.2.1  is  a  schematic  diagram  of  the  Peaucellier  Lipkin  Exact  Straight 
Line  Mechanism.  There  are  8  bodies  in  this  mechanism  and  10  revolute  joints. 

The  lengths  of  the  links  comply  with  the  conditions: 

AC  =  CB  =  BF  =  AF  =  a 
DF  =  DC  =  b 
EA  =  ED  -  C 

The  mechanism  always  satisfies  the  condition 
(DA) (BD)  -  a2  -  b2  -  R2 
where  R  is  an  inversion  constant 

Body  1  is  ground.  Crank  link  2  rotates  about  the  fixed  axis  E.  The 
motion  of  the  crank  link  2  is  given  as, 

4> 2 ( t)  *  (t/100.00) 

where  t  represents  time.  Point  B  of  the  mechanism  translates  along  a  vertical 
line  q-q  which  is  always  at  a  distance 


2(AE) 


from  point  D. 


BODY  DATA 


Length 

X 

eg 

Y 

eg 

eg 

Mass 

M.  Inertia 

5.0 

0.0 

0.0 

0.0 

0.0 

0.0 

5.0 

-2.5 

0.0 

0.0 

10.0 

10.0 

14.14 

0.0 

5.0 

ir/4 

10.0 

10.0 

14.14 

0.0 

-5.0 

-n/4 

10.0 

10.0 

10.00 

5.0 

5.0 

0.0 

10.0 

10.0 

10.0 

5.0 

-5.0 

0.0 

10.0 

10.0 

14.14 

15.0 

0.0 

— tt/4 

10.0 

10.0 

14.14 

10.0 

-5.0  , 

it/ 4 

10.0 

10.0 

JOINT  DATA 


Joint  #  Joint  Type  Body  i  Body  j  X1J  YIJ  XJI  YJI 


TABLE  6.2.1:  Data  for  Peaucellier  Lipkin  Mechanism 


TABLE  6.2.2 
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At  joints  A,  C,  0,  and  F,  three  links  are  connected  by  a  single  revolute 
joint.  The  simulation  is  done  by  specifying  two  revolute  joints  at  the  same 
point  in  space,  connecting  the  three  bodies.  Any  revolute  joint  can  be  used 
to  connect  any  two  bodies,  as  long  as  one  avoids  having  the  same  two  bodies 
attached  by  the  two  revolute  joints. 

In  the  simulation  model,  the  center  of  mass  of  link  7  is  located  at  point 
B.  Thus,  when  crank  link  2  turns,  one  would  expect  the  x-coodinate  of  link  7 
to  remain  constant.  The  simulation  results  indeed  show  the  above  to  be  true. 

The  input  data  for  the  problem  is  shown  in  Table  6.2.1.  The  simulation 
period  for  this  model  was  10.0  seconds  and  a  solution  was  forced  every  0.1 
seconds.  Compiling  time  was  3.44  seconds  and  execution  time  was  25.25  seconds. 

All  computations  were  done  in  double  precision  using  a  WATFIV  compiler  and  an 
ITEL-AS-8  computer. 

6.3  Example  Problem  3;  Link  Gear  Multiplier  Mechanism 

Figure  6.3.1  is  a  schematic  diagram  of  a  Link  Gear  Multiplier  Mechanism.  This 
is  a  three  degrees-of-freedom  model.  When  three  inputs  are  prescribed  (through 
bodies  3,  11  and  12),  the  output  of  link  6  is  a  product  of  the  inputs. 

There  are  8  bodies,  1  revolute  joint,  and  10  translational  joints  in  the 
mechanism.  Slotted  link  4  turns  about  the  fixed  axis  A.  Links  2,  3,  11,  and 
12  slide  on  fixed  guides  in  body  1,  and  have  slots  in  them  for  connections  with 
bodies  5  and  12.  When  inputs  y^(t),  and  x^(t)  are  sPec^fiet^»  the 

system  responds  with  the  motion 

xfi(t)  «  y3(t)  •  x12(t)/yil(t) 

Bodies  4  and  2  can  turn  with  respect  to  the  pin  5.  Similarly,  bodies  12 
and  4  turn  with  respect  to  pin  8.  To  model  this  mechanism  with  standard  elements, 
fictitious  bodies  6,  7,  9,  and  10  have  been  introduced.  3odies  5  and  6,  6 
and  7,  8  and  9,  9  and  10  are  connected  by  revolute  joints.  Body  5  slides  along 


Figure  6.3.1: 


Gear  Multiplier 


INPUT  DATA 


BODY  DATA 


Body  it  Length 


X 

Y 

$ 

Mass 

M.  Inertia 

eg 

eg 

eg 

0 

0 

0 

10.00 

20.00 

10.00 

2.00 

0.00 

10.00 

20.00 

-  2.00 

10.00 

0.00 

10.00 

20.00 

5.00 

5.00 

0.7854 

10.00 

20.00 

10.00 

10.00 

0.00 

10.00 

20.00 

10.00 

10.00 

0.7854 

10.00 

20.00 

10.00 

10.00 

0.00 

10.00 

20.00 

20.00 

20.00 

0.00 

10.00 

20.00 

20.00 

20.00 

0.7854 

10.00 

20.00 

20.00 

20.00 

0.00 

10.00 

20.00 

5.00 

20.00 

0.00 

10.00 

20.00 

20.00 

30.00 

0.00 

10.00 

20.00 

JOINT  DATA 


Type (joint  it 


Body  I  [  Body  J 


YIJ 


0.0 

0.0 

0.0 

0.0 

0. 
1. 

0.0 
0.0 
25.0 
-  1.0 
1.0 
0.0 
-  1.0 
1.0 
0.0 


Data  for  Link  Gear  Multiplier 
TABLE  6.3.1 


XJI 


-7.071 

0.0 

0.0 

0.0 

0.0 

0.0 

1.0 

-2.5 

0.0 

0.0 

0.0 

4.0 

0.0 

0.0 

1.0 


Time 

(Secs)  Y 3  X12  Yll  (Y3) (X12) /Yll 
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body  3,  body  6  slides  on  body  4  and  body  7  slides  on  body  2.  Similarly, 
body  8  slides  on  body  11,  body  9  slides  on  body  4,  and  body  10  slides  on 
body  12. 

The  model  used  for  simulation  thus  has  12  bodies,  5  revolute  joints  and 
10  translational  joints.  The  dimensions  of  the  mechanism  may  be  arbitrary, 
provided  the  topological  configuration  does  not  change.  The  input  data  for 
the  problem  are  shown  in  Table  6.3.1. 

Table  6.3.2  contains  results  of  the  simulation.  Columns  2,  3,  and  4 
contain  the  values  Y3,  X12,  and  Yll,  respectively.  Using  these  values,  the 
expected  value  of  X6  is  computed  and  printed  in  column  5.  Column  6  contains 
the  actual  value  of  X6,  as  obtained  from  the  simulation. 

The  simulation  period  for  the  job  was  10.0  seconds,  with  a  solution 
being  forced  every  0.10  seconds.  All  computations  were  done  using  a  WATFIV 
compiler,  on  an  ITEL  AS-8  computer.  Compilation  time  was  3.51  seconds,  and 
execution  time  32.46  seconds.  Total  cost  of  the  job  was  $20.79. 

6.4  Example  Problem  4:  Force  driven  4-bar  linkage 

Figure  6.4.1  is  a  schematic  figure  of  a  4-bar  linkage,  which  has  one 
degree-of-freedom.  The  mechanism  is  initially  in  a  non-equilibrium  position. 
The  problem  at  hand  is  to  find  the  equilibrium  position  of  the  mechanism  when 
it  is  subject  to  its  own  body  forces. 

Pertinent  input  data  are  shown  in  Table  6.4.1.  The  values  of  the  general¬ 
ized  coordinates  and  the  Lagrange  multipliers  at  equilibrium  position  are 
computed. 

It  must  be  noted  that  for  the  force  driven  case,  the  program  attempts 
to  find  an  equilibrium  position  if  such  a  position  exists  at  all.  Thus, 
there  is  no  parameter  like  time,  as  in  analysis  of  kinematically  determinate 
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BODY 

DATA 

Body  it 

Length 

X 

cm 

Y 

cm 

<t> 

cm 

Mass 

MI 

1 

100 

0.0 

-0004 

0.0 

0.0 

0.0 

2 

100 

8.682 

-49.240 

-1.3962 

1.0 

1.0 

3 

100 

67.36 

-98.480 

0.0 

1.0 

1.0 

4 

100 

108.682 

-49.24 

-1.3962 

1.0 

1.0 

JOINT  DATA 


Joint  it 

Joint  Type 

Body  I 

Body  J 

X1J 

Y1J 

XJI 

YJI 

1 

RVLT 

1 

2 

0.0 

0.0 

-50.0 

0.0 

2 

RVLT 

2 

3 

50.0 

0.0 

-50.0 

0.0 

3 

RVLT 

3 

4 

50.0 

0.0 

-50.0 

0.0 

4 

RVLT 

4 

1 

50.0 

0.0 

-50.0 

0.0 

Data  for  Four-bar  Linkage 


Table  6.4.1 
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RESULTS 


Estimates  obtained  using  $ ^  -  const.  a  -1.3962  rads 


Body  # 

X 

Y 

(ji(Rads) 

1 

rH 

» 

O 

H 

0 

0 

2 

8.68553 

-49.2398 

-1.3962 

3 

67.3711 

-98.479 

io-14 

4 

108.6855 

-49.2398 

1.7453 

Estimates  of  Lagrange  Multipliers 


JT  # 

Ax 

1 

45.40 

386.08 

2 

45.40 

128.69 

3 

45.40 

-128.69 

4 

45.40 

-386.08 

Constraint 


a  .  io°  .  o  8942.34 

2  (Moment) 

Execution  time  -  0.51  secs,  in  the  ITEL  AS-8  Computer 
0  of  iterations  ■  2 
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FINAL  RESULTS 


Generalized 

Co-ordinations 

Body  it 

X 

Y 

4 1  (Rads) 

1 

0 

0 

0 

2 

10-14 

-50.00 

-1.5708 

3 

50.00 

-100.00 

io-17 

4 

100.00 

-  50.00 

1.5708 

Lagrange  Multipliers 


Joint  it 

Ax 

Xy 

1 

10-13 

386.08 

2 

io"13 

128.696 

3 

10"13 

-128.696 

4 

10-13 

-386.088 

CPU  Time  -  1.02  secs 
it  of  Iterations  *  2 
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The  solution  strategy  for  force  driven  mechanisms  is  slightly  different 
from  what  has  been  explained  in  the  previous  examples.  The  program  has  been 
coded  such  that  all  Lagrange  multipliers  have  zero  initial  estimates.  During 
subsequent  iterations  for  closure  of  the  mechanism,  these  estimates  are 
expected  to  reach  the  correct  values. 

The  difficulty  with  this  strategy  is  that  very  often  the  Jacobian 
matrix  of  first  derivatives  does  not  have  full  row  rank  especially  when  all 
Lagrange  multipliers  have  zero  initial  estimates.  To  overcome  the  problem 
caused  by  singularity  of  the  matrix,  the  sparse  matrix  code  fixes  values  for 
K  of  the  state  variables  arbitrarily  where  K  is  the  nullity  of  the  matrix, 
and  proceeds  to  solve  for  the  remaining  unknowns  from  the  largest  non¬ 
singular  submatrix  available. 

Thus,  the  configuration  of  the  mechanism  is  changed  considerably  from 
what  was  initially  specified.  Since  the  initial  estimates  of  the  dependent 
variables  have  not  changed,  the  input  data  is  not  a  good  estimate  any  more. 

Thus  while  attempting  loop  closure,  the  program  may  need  several  iterations 
and  in  some  cases  closure  may  not  be  attained  at  all.  To  offset  this 
computational  difficulty,  the  following  strategy  is  employed:  If  a  mechanism 
has  f  degrees-of-freedom,  f  coordinates  are  kept  fixed  by  the  code  at  their 
initial  estimates.  Thus,  one  can  now  obtain  the  generalized  coordinates  by 
solving  the  constraint  equations.  Once  all  the  variables  have  been  obtained, 
Lagrange  multipliers  are  computed. 

The  values  computed  above  are  read  as  initial  estimates  for  the  force 
driven  system.  Since  one  has  a  reasonable  estimate  of  the  Lagrange  multipliers 
and  other  generalized  coodinates,  closure  will  be  attained  reasonably  quickly. 

This  method  may  not  work  well  for  problems  in  which  the  initial  estimates 
are  inaccurate,  but  for  reasonably  good  initial  estimates  closure  is  guaranteed. 
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CHAPTER  7 
Conclusions 

The  basic  attempt  in  this  report  is  to  formulate  and  code  a  general 
purpose  method  for  kinematically  analyzing  force  driven  and  kinematically 
driven  mechanisms. 

It  was  shown  that  for  the  kinematically  driven  systems  constraint 
equations  can  be  used  to  evaluate  the  generalized  coordinates.  Successive 
differentiation  of  the  constraint  equations  yield  velocities  and  accelerations. 
The  equations  of  equilibrium  were  shown  to  be  uncoupled  from  the  constraint 
equations,  and  the  unknown  Lagrange  multipliers  can  be  computed  even  after 
including  inertial  effects.  In  all  cases,  it  was  shown  that  the  coefficient 
matrix  is  the  (3 <p /3 q)  matrix  or  its  transpose,  and  hence,  computations  of 
velocities,  accelerations  and  Lagrange  multipliers  are  not  very  expensive. 

It  was  shown  that  for  the  force  driven  system,  the  equations  of  equili¬ 
brium  and  the  constraint  equations  were  coupled.  To  avoid  solving  the  dif¬ 
ferential  equations  of  motion,  it  was  assumed  that  inertial  effects  were 
negligible  and  thus  this  solution  technique  Is  applicable  only  to  kinetostatic- 
quasistatlc  systems. 

Three  example  problems  of  varying  complexity  were  solved,  and  the  solution 
strategy  was  shown  to  be  feasible.  Solution  of  velocities  and  accelerations 
have  not  been  included  in  the  present  code  but  can  be  done  with  very  few 
modifications  in  the  main  program. 
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